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I. INTRODUCTION 


Operational use of Unmanned Aerial Vehicles (UAV) continues to expand 
throughout the U.S. Armed Forces. This has placed increasing demands on the accuracy 
of the navigation systems used to guide these remotely controlled or autonomous 
vehicles. Future tasks such as autonomous landings aboard deployed vessels or land- 
based expeditionary fields require precise navigation. Differential Global Positioning 
System (DGPS) available today is very accurate but offers relatively slow position update 
rates of one time a second. Inertial Navigation Systems (INS) provides updates at much 
higher rates but lacks the accuracy of DGPS due to numerous inherent errors. These two 
systems have been integrated to provide a precise navigation system. 

While DGPS is far more ennai for position information than the INS is slow |] 
Hz update rate is a distinct drawback in guidance systems requiring accurate position 
estimates on demand. The goal of this project was to improve on the accuracy of the 
navigation system employed on the FOG-R Unmanned Air Vehicle (FROG UAV). This 
was to be accomplished through the use of a complementary filter to provide position and 
wind estimates in between DGPS updates. Development of this filter was accomplished 
using the Matrix, product family of rapid prototyping software available from Integrated 
Systems Incorporated (ISI). The development process utilized the Realsim, Xmath, and 
System Build design tools with their associated Graphical User Interface (GUI) to step 
through the design process. This control system design and implementation software 
package was executed on the Texas Instruments TMS320C30 Digital Signal Processor 


(C30 DSP) hosted on an IBM compatible PC. The GPS system used throughout this 


thesis utilizes two Motorola PVT-6 OEM receivers. The IMU used is the Watson IMU- 
600AD. This thesis describes the development of the position and angle filters for use in 
the navigation system as integrated with the existing FROG command and control. 

The FROG UAV used for this project is a remotely controlled (RC) aircraft with a 
ten foot wing span and 20 pound payload capacity. The aircraft 1s equipped with an 
avionics suite consisting of an Inertial Measuring Unit (IMU), Differential Global 
Positioning System (DGPS), and air data sensors. It is controlled through the use of a 
Radio Frequency (RF) link that sends Pulse Width Modulated (PWM) signals to the 
onboard autopilot. The RF link was modified to accommodate control by a ground 
station consisting of SPARC workstation, luggable C30 DSP and communications box. 
The onboard GPS was used in the differential mode with the ground station DGPS placed 


on a surveyed point at the flight test airfield, sending differential corrections to the UAV. 


Ii. BACKGROUND 


To understand the implementation of the position filter some background must be 
introduced. The following discussion will address the sensors used in the implementation 
of the filter. It utilizes several different coordinate systems, including Local Tangent 
Plane (LTP), Body-Fixed and Wind systems. The fundamental relationship between 
linear position and velocity, which are the basis for the development of this filter, 1s also 


addressed. 


A. DIFFERENTIAL GLOBAL POSITIONING SYSTEM 

The integration of DGPS into the FROG navigation system was accomplished in a 
previous thesis project. A component level discussion of the DGPS system is not 
necessary for the purposes this thesis. It 1s essential, however, to be familiar with the 
characteristics of the position data provided by the DGPS. While the accuracy of this 
information in a static environment is typically within nee meters, the best case position 
update rate remains relatively slow at once a second (1 Hz). Considering the spectrum of 
average speeds of platforms on which DGPS can be employed, the FROG UAV of 80 
feet per second (fps) to the modern tactical jet at 500 fps, it < evident that extremely 
precise flight path and ground track navigation is impossible using only GPS available at 
that rate. For this reason DGPS has been integrated with the Inertial Navigation System. 


[Ref. 1] 


Vehicle position is provided by the DGPS in the form of latitude, longitude and 
geoide height. As mentioned earlier, the task of converting that position information for 
use in the local tangent plane (LTP) has already been accomplished. The filter uses this 
vehicle position data provided in the LTP frame in units of feet. This data is used as an 
input to the filter to form the position error signal when compared to the position 


estimates developed by the filter. 


B. INERTIAL MEASURING UNIT 

Unlike the DGPS, the Inertial Measuring Unit is a self-contained unit of 
accelerometers and gyros which measure aircraft specific acceleration, angular rates and 
inertial orientation. The position filter needs to know the onentation of the aircraft’s 
body axes with respect to the inertial frame. These quantities, known as Euler angles , 0 
and w, define this orientation in roll, pitch and yaw, respectively. For the purposes of this 
project it is sufficient to treat the local tangent plane as the inertial or universal frame. 
One of the tasks of this project was to determine whether the Euler angle information 
provided by the IMU would be suitable for use in the position filter. Typically these 
quantities are filtered [Ref. 2] to produce accurate estimates of the angles which are 
ultimately available for use in the navigation system. Specifics on the suitability of the 


Euler information provided by the IMU for use in the filter are discussed in Chapter VI. 


Cc COORDINATE SYSTEMS 

a Local Tangent Plane 

The LTP coordinate system is defined by passing a plane through any point on the 
earth’s surface with that plane being tangent to the surface at that point as shown in 
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Figure 2.1: Local Tangent Plane From Ref. [3]. 


The point of intersection of the plane with the surface of the earth 1s defined to be 
the origin of the LTP system. The X-axis points toward true North. The Y-axis is 
perpendicular to the X-axis and points toward true east. The Z-axis is perpendicular to 
the defining plane of the system, away from the center of the earth. This particular 


definition represents a North-East-Up (NEU) orientation. The orientation of the frame 


can be specified in a number of ways: East-North-Up (ENU) or North-East-Down 
(NED). [Ref. 2] 

am Body-Fixed Frame 

The body-fixed frame is a nght-hand orthogonal coordinate system with its origin 
located at the vehicles center-of-gravity (cg). The X-axis points forward through the 
aircraft nose. The Y-axis points towards the right wing tip and the Z-axis 1s perpendicular 


to the X-Y plane pointing downward as shown in Figure 2.2. 





Figure 2.2: Body Fixed Frame From Ref. [3]. 


ay Wind Frame 

The wind axis coordinate system, {w}, is defined as the coordinate system that 
results when the body-fixed x, axis is aligned with the relative wind. This axis will not 
normally be aligned with the body coordinate system since the aircraft flies with an angle 


of attack, @ , and can have a sideslip £ as shown in Figure 2.3. 





Figure 2.3: Alpha and Beta Angles from Ref. [4]. 


D. COORDINATE TRANSFORMATION 

|e Inertial to Body 

Euler angles are used to define the orientation of two coordinate systems with 
respect to each other. These angles define how the body-fixed coordinate system {b} is 
oriented with respect to the local tangent plane or universal frame {u} in terms of roll o, 
pitch 0 and yaw wW as shown in Figure 2.4. The Euler angles enable the transformation or 
rotation of vector information to and from these two coordinate systems. 


P, 





Figure 2.4: Euler Angles Phi, Theta and Psi From Ref. [3] 


This rotation matrix ,'C is shown in Equation | and is used to transform vehicle 


velocity with respect to the air mass (indicated airspeed) from body-fixed frame to 


inertial frame. 


x, | |cos@cosy —cosdsiny+singsin@cosy  singsiny+cos¢sinO@cosy |} x, 
y,|=| cos@siny cosgcosy+singsné&siny —singcosy+cosPsinésiny |) y, | 


Zz —sin@ singcos@ cospcos@ As 
pe Wind to Body 
As shown in Figure 2.3 it is possible to define the orientation of {w} to {b} with 
the use of the angles @and #. Using these angles it is possible to construct the 


transformation from {w} to {b}. This transformation 1s performed in the same fashion as 


b . : 
C, 1s a function 


> w 


the Euler angle transformation discussed earlier. The rotation matrix 


of a and # and is expressed as: 


cosacos# -cosasinf —sing 
bh : 
we = sin B cos B 0 j 


sinacosfZ -sinasinf cosa 
For the purposes of this thesis this rotation is assumed to be identity due to the 
fact that the FROG operates in a flight regime where the angle of attack and sideslip are 


negligible. This assumption will be validated in Chapter V. 


i: LINEAR POSITION AND VELOCITY 
Euler angles measured by IMU can be used to obtain the rotation matrix ;C. 
This enables the use of the relationship between linear position resolved in the LTP or 


universal frame {u} and velocity resolved body-fixed frame discussed next. 


Let “V., be the velocity of the aircraft center-of-gravity with respect to the 


universal frame resolved in universal frame {uj}. Let "V,, be the velocity of the aircraft 


center-of-gravity (cg) with respect to the wind frame. Let "P., be the position of the 


aircraft cg with respect to the universal frame resolved in the universal frame and let 
“V,, be the velocity of the air mass (wind) with respect to the universal frame resolved in 
universal frame. Then _ 
"p= ICV +", . 

Equation 3 shows the relationship implemented within the filter. It is apparent 
that the difference of true inertial velocity and indicated airspeed is the velocity of the 
wind. By extension, a comparison of DGPS position, in this case true position, and 
position estimate derived by integrating indicated airspeed should result in an error signal 


that when integrated will estimate the bias between true inertial velocity and indicated 


airspeed, which is the velocity of the wind. 


ak|0) 





HW. FILTER DESIGN REQUIREMENTS 


A. DESIGN GOALS 

The basic goal for the design of this filter 1s to improve the accuracy of the 
position estimate provided by the navigation system when the DGPS position update is 
not available. When the DGPS position update information Ppgps is available, the filter 
should use it to update the position estimate Pp developed by the filter. In steady state Pp 
should equal P,.p.. The improvement is provided in the form of an accurate position 
estimate between DGPS updates since the filter can now use the learned wind and 


measured vehicle airspeed to accurately estimate position. 


B. BASIC COMPLEMENTARY FILTER DESIGN 


Equation 3 suggests the following realization for the complementary filter shown in 


Figure 3.1. 
Ves Veg aR P 
+ 
a P DGPS 





Figure 3.1: Complementary Filter Block Diagram 
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where: 4 


and k; and k2 represent the filter gains. In the state space form the realization becomes: 


6 ]_[-* 1s) feL, Jb, 
| |-& olfx, |" [Le [2 “Lo] “@ 


Using Equation 5 it is possible to then determine the transfer function of the 
output P. 


P(s) = C(SI- A)'B 6 


Completion of this matrix multiplication yields: 


A l sl k, i 
Me sacanl Ole, scale Lol 


(sk, + k,] ; 


P(s) = s=————— Paps. + = “V, 
S+kstk, ~" s'+khst+k, * 
From this transfer function representation and application of the final value 


theorem it can be shown that in steady-state the position estimate P is equal to the DGPS 


position Preps: 


‘ k 
P (0) a a ts DGPS # 


2 


ce 


which 1s the desired outcome since, 


P= "CV, +'V, => P- tC 'V, = "V,. 9 
Therefore, it is apparent that this implementation can accurately estimate the 
vehicle position in steady-state due to the ability of the integrator to learn the wind (bias) 
and apply this correction to the measured indicated airspeed. 
Selection of filter gains k; and kz was made to ensure stability and provide 


reasonable response time. Using these criteria k; and k7 were chosen as six and nine 


respectively providing reasonable response time and time constant of .3. 


i 
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IV. REALSIM IMPLEMENTATION 


A. SOFTWARE OVERVIEW 

Use of the REALSIM software installed on the UNIX workstations and its 
application in the design and testing of dynamic control systems has greatly simplified 
the workload of the control engineer. Through the use of a Graphical User Interface 
(GUI) shown in Figure 4.1 the designer can follow a flow diagram outlining the different 
software tools and components used to implement a given design. These software tools, 
all members of the Matrix, product family, consist of Xmath/SystemBuild, Autocode, 
Interactive Animation (IA) Builder, Hardware connection Editor (HCE), and utilities 
used to compile, link, download and run the coded control design. The use of REALSIM 
for the design of UAV control systems was explored in an earlier thesis project. A brief 
description of these applications is given next. [Ref. 5] 

1. Xmath/SystemBuild 

Xmath/SystemBuild includes an extensive set of design and analysis functions for 
the classical input/output control techniques and the modern state-space control 
techniques. The SystemBuild program uses a hierarchical method of organization, based 
on the SuperBlock concept. SuperBlocks provide a way of organizing a group of blocks 
that define a function into a compact form for ease of display and understanding. 
Through the use of this hierarchy, variable names and associated signals can be passed up 
and down the hierarchical structure allowing the engineer to easily track and understand 
what variables are and where they interacts with the model. A diagram showing the 


interaction of Xmath and SystemBuild is given in Figure 4.2. 
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Figure 4.1: REALSIM Graphical User Interface 
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Figure 4.2: Xmath/SystemBuild Relationship 
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Once a given realization is drawn and labeled, there are several ways to test the 
model. It can be tested within Xmath/SystemBuild using the “SIM” function or by 
generating realtime code. The second method is preferred, since it allows for the 
generation of a higher-level language to conduct hardware-in-the-loop testing. To 
generate real-time code the user utilizes a pull-down menu on the SystemBuild GUI and 
selects “Generate Real Time Code”. This produces a file with the model name and 
appended .rtf extension. This Real Time Code is a top level Input/Output code used by 
the AutoCode program to produce a higher-level code such as C. [Ref. 6] 

a AutoCode 

An integral part of the quick design and testing of a controller is the ability to 
generate high-level code such as ADA or C automatically. AutoCode fulfills this task by 
generating optimized code from a library of standard functions and calls. The Realsim 
package in the Avionics lab utilizes the C code module. Code generation is 
accomplished by first ensuring the target_config.cfg file settings are correct and then 
clicking the AutoCode button on the main Realsim GUI shown in Figure 4.1. The 
target_config.cfg file 1s created using the Realsim retarget utility. This designates the 
network computer on which the application will be compiled , downloaded and executed. 
Once the code generation is complete a new .c appended file is created in the working 
directory which will later be used to compile, link, download and run the coded design. 
[Ref. 6] 

3. Interactive Animation Editor (IA) 

Interactive Animation Editor (IA) is used to build a graphical animation and 
necessary user interface module to display and control desired system input/output (I/O) 


parameters during testing. User display and interface screens are constructed through a 


diy) 


drag and drop process using a library of pre-drawn gauges, strip charts, dials, switches, 
and other input/output devices. Custom display pictures can also be created. The “RTF 
Names” button loads the I/O names from the model .rtf file to ensure correct association 
of given I/O signals to their display icons. An RTF file must be loaded prior to making 
any connections in the JA editor. The IA connection editor is similar to that used in 
SystemBuild. Following the completion of a picture the user selects “Save Picture” and 
an appended .pic file is added to the working directory. This file will be used later in the 
Hardware Connection Editor (HCE) and link process. Note: if the SystemBuild J/O is 
changed, the [A Editor must be run again and connections changed to reflect the changes 
to the model. [Ref. 5] 

4. Hardware Connection Editor 

The hardware connection editor is used to associate external inputs and outputs in 
the SystemBuild model with either external I/O devices or the I/A module. This is 
accomplished using two editor screens, one for external input and one for external 
outputs. 

The HCE reads the external I/O from the .rtf file having the same name contained 
in the current target information. The HCE determines if a local copy of the c_¢30.hce is 
present and, if so, reads the file. If not, a default is read out of the AC100 or AMERICA 
directory. This file informs the HCE what type of external I/O devices are present in the 
target AC100 computer. A detailed explanation of these screens and their uses can be 


found in the Matrix, Core Manuals, [Ref. 5]. 


des} 


3) Compile and Link 

Once the desired inputs and outputs are connected, the design needs to be 
compiled and linked to the C30. The Realsim software will attempt to connect via ftp 
with the targeted computer. Once the connection is made, the required source C files will 
be transferred to the target computer for remote compiling and linking. The compiler 
generates object code from the .c source file, and the link creates a C30 DSP executable 
code from the object code. If there are other C files required for the project for compiling 
and linking there should also be a file in the working directory named sa_user.cmd. In 
this file there should be a line that reads COMPILE <<filemane>>.c and one reading 
LINKWITH<<filename>> for every all external user produced C-code files. [Ref. 6] 

6. Download and Run 

When this program is selected on the GUI, Realsim will attempt to connect to the 
target computer. Once the connection in made, the executable code is loaded into the 
C30 memory where it is prepared to run. The IA module is then brought on the screen 
along with an JA Client. The IA Client is shown in Figure 4.3. 

The first IA Client button, “Start Controller’, will start the model if the model has 
jest been loaded and not yet run. It will stop the model if it is currently running and 
restart it if 1t had previously been stopped. The second “Hardware Reset” button causes 
the Realsim controller to immediately reset and exits the [A Client. This action clears the 
C30 memory and returns the target computer to a ready status. The “Exit Graphics” exits 
the IA Client without rebooting the target controller. This is a software reboot only, 
which stops the model and terminates the ftp connection. This button is not 
recommended for use due to its inability to stop the model from running on C30. If 


download and run is selected again by the original client which started the model, it will 
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Figure 4.3: [A Client Control Window 


ask if you wish to reconnect the model. If a different client attempts to log on to run a 
model it will ask if the current model should first be terminated. Therefore it is always 
preferable to terminate the model by selecting stop controller and hardware reset. The 
“Start Data Acquisition” button starts and stops data acquisition. Each time Start Data 
Acquisition is selected data signals selected via the Data Acquisition Editor are recorded 
and stored in a project_name.raw file. Following flight test, these files are converted to 
project_name.dat files for use in system analysis. Data acquisition should be stopped 
before stopping the controller. Should the controller be stopped before the data 
acquisition stops the acquired data will not be saved to a file. The “Scale Frequency” 
button allows the user to set certain data acquisition parameters. Other data acquisition 
features can be invoked from the menu located in the upper right corner of the Realsim 


GUI and selecting “Show Utilities”. These utilities enable the user to capture specific 
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data within the model for use in Xmath. More information can be found in the Matrix, 


Core Manuals. 


B. FILTER INPUTS 

1. Velocity 

Measured FROG airmass velocity is available from the existing on-board 
instrumentation and within the SystemBuild hierarchy developed earlier. Calibration of 
this data is addressed.in Appendix A. The velocity, in units of feet-per-second, is 


provided to the GPS_filt Superblock in Figure 4.4 through an external input in the form: 


“Vig =| 0 10 


where V7 is the aircraft indicated airspeed. This velocity is then resolved in the inertial 


frame in the “b_to_i” block (14) through the use of the rotation matrix ;C utilizing the 


Euler angle inputs. 
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Figure 4.4: Continuous Position Filter gps_filt 
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2. Euler Angles 

Estimates of the Euler angle psi are generated in the Sensor Filters SuperBlock 
shown in Figure 4.5 using DGPS heading (hea), IMU angular rate information [p, gq, r] 
and GPS inertial velocity. Heading estimates are computed through complementary 


filtering of psi_dot, generated in the L_dot_eq SuperBlock, and DGPS heading hea. 


simple comp_ 
Eeute heta 
heta_dot 
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Figure 4.5: Euler Angle Filter Bank in Sensor Filters SuperBlock 


This project will address the determination and evaluation of psi in the 


implementation of the filter and the generation of a low frequency phi estimate. 


BE 


2. DGPS Position 
The task of incorporating DGPS into the FROG navigation system was 
accomplished in an earlier thesis [Ref. 1]. DGPS position resolved in Local Tangent 


Plane is taken as input in units of feet north, east and down. 


C. FILTER OPERATION 

The goal of this project was to implement a filter, using available INS and DGPS 
information, that would provide accurate position estimates in the inertial frame when 
DGPS was not available, i.e. between the one second updates. It is essential that all 
computations be made with data resolved in the same reference frame. This is 
accomplished in the filter through the use of the available Euler angle estimates and 
application of the transformation matrix to resolve velocity in the inertial frame {u}. 
Another essential operation is to compare the estimated position with the DGPS position 
when available. The important point here is to realize that a new error signal is available 
only at the same rate as the DGPS update. This error signal is determined by subtracting 
estimated position from DGPS position: 

e= (Ron ~ P) 1] 

In the absence of a DGPS update the feedback gains k; and k» must be 
disconnected. This results in the position estimate being computed based on an inertial 
velocity that, until the integrator has “learned” the bias (wind), will be erroneous. The 
discrete version of the feedback portion of the position filter shown in Figure 4.6 
implements the logic needed to turn the feedback gains on and off. This is accomplished 
by comparing the current Ppgps input to the previous value, which is completed in 


summing block (93). When that result is non-zero, i.e. there has been a DGPS update, 


aS 


the gains are connected and the latest position is used to improve the estimates. This 
switching logic is implemented using a combination of coded (C-code) blockscript and 


data path switches. 
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Figure 4.6: Discrete Position Update and Gain Switching Implementation 


The blockscript, Plogic, takes the result of the summing block (93) difference of 
the current and previous Ppgps value and computes its norm. The code generates a 
boolean output which is high when the norm is non-zero (DGPS has updated) and low 
otherwise. This logic triggers the data path switch to either connect or disconnect the 
feedback gains. 

Learning the bias between the indicated airspeed and the estimated inertial 


velocity, which is the wind estimate, enables the filter to develop an accurate estimate of 


24 


the inertial velocity and position. It is apparent that in steady state the filter provides 


accurate estimates of the position and its derivative, inertial velocity. 


D. FILTER OUTPUTS 

1. Position Estimate 

The position information, DGPS or position estimate, 1s taken as the three channel 
output of the data path switch and labeled North_Itp_filt, East _Itp_filt and 
Down _Itp _filt corresponding to outputs ten, eleven and twelve of Block (96) in gps_filt. 
This position information is then taken to the highest upper-level SuperBlock, Process 1, 
where it is then sent through the output variables gain block and made available as an 
external output for use in data acquisition, flight test and animation display. 

dap Wind Estimate 

The wind estimate 1s ayia at the output of the data path switch block (16) in 
Figure 4.7 where it 1s labeled wind_bias_n, wind_bias_e and wind_bias_d and taken as 
output seven, eight and nine. From the GPS_Filt SuperBlock it follows the same path as 
the position information as an external output. This information is essential in evaluating 
the performance of the filter during flight test and is discussed in Chapters V and VI. 

5. Inertial Velocity 

Inertial velocity 1s available at the output of the summing junction block (3) of the 
GPS_Filt SuperBlock in Figure 4.7 where it is labeled V_i_n, V_i_eand V_i d and taken 
as output 28, 29 and 30 respectively. This velocity information follows the same path as 


the position and wind information as an external output. 


Zo 





Figure 4.7: Discrete Position Filter 
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V. SIMULATION 


A. FROG MODEL 

The development of a dynamic model of the FROG UAV was accomplished in a 
precious thesis project [Ref. 7]. Two of the three inputs required for the implementation 
of this filter are available as outputs from this dynamic model. The parameters of body 
referenced velocity resolved in wind frame and the Euler angles yw, @ and @ are 
computed and available for use as inputs to the position filter. The FROG model also 
needed control deflection information which was available from a previously developed 
model of the autopilot used on the FROG [Ref. 8]. Future references to the FROG model 
will include both the FROG and Autopilot models. 

The initial conditions for the FROG model are established in the state space 
Initial Conditions block (97) within the FROG SuperBlock shown in Fig. 5.1. The input 
vector, Xg to x;;, establishes the initial values of the parameters used in the FROG model 


which are [uo Vo, Wo, Po, Jo,'o, 0,90, Y 0, Px0, Pyo, PZo. | 





Figure 5.1: Frog Model Initial Conditions Block 
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These parameters are defined below: 


Inertial Velocity with respect to {u} resolved in {b} 


Angular Rates of Roll, Pitch and Yaw resolved in {b} 
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Velocity is input in units of feet-per-second, angular rates in radians-per-second, 
angles in radians and position in feet relative to LTP origin. The velocity components of 
the wind are inputs to blocks (94) and (95) of the dynamics euler SuperBlock shown in 
Figure 5.2. Block (94) contains the simulated wind velocity in {u} frame which is output 
to wind_u2b block (95). Here it 1s resolved in {b} frame for use in the aero forces and 
moments block (96). Use of these initial conditions and wind parameters will be 


discussed in Section C of this chapter. 


B. DGPS UPDATE 
Modeling of the DGPS update rate was accomplished in the gps_updt block(98) 
within the pos_updt_mdl SuperBlock shown in Figure 5.3. The gps_updt SuperBlock 


receives true position, simulating DGPS position information, from the FROG model. 


Zo 


For continuous time simulation the position information passes through block (4) and is 


unaltered. For discrete time various update rates were simulated by changing the sample 


interval of the discretized gps updt SuperBlock. This is easily accomplished in 


SystemBuild and will be discussed in section D. 
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Figure 5.3: Continuous pos_updt_mdl SuperBlock 
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C. CONTINUOUS TIME SIMULATION 

Continuous time simulation of the mechanization developed in Chapter HI was 
completed using Xmath/SystemBuild with the continuous version of pos_updt_mdl 
SuperBlock shown in Figure 5.3. This SuperBlock contained the frog, autopilot, 
gps_updt and gps _filt SuperBlocks. Initial conditions for each simulation were input in 
the appropriate SuperBlock as described in Section A of this chapter. The basic 
procedure for the continuous time simulations was to run the pos_updt_mdl with varying 
sets of initial condition and wind parameters for each of ten gps_filt filter gains from one 


to ten. Outputs of each simulation included but not limited to: 


e Position Error (Pig = P) in units of feet North, East and Down LTP 


e Inertial velocity error ("V aay in units of fps North, East and Down LTP 


all 

e Wind (bias) velocity in units of fps North, East and Down LTP 

A sample of the position error and wind estimate results from a continuous time 
simulation are shown in Figure 5.4. All simulations used initial conditions of [u=80, 
r=.1, phi=.2] with all others being zero. Filter gains k; and k> were nine and six 


respectively for all simulations as discussed in Chapter III. 
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Figure 5.4: Continuous Simulation Position Error and Wind Estimate 
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D. SYSTEM DISCRETIZATION 

It Continuous to Discrete Transformation 

Transformation of the continuous time pos_updt_mdl SuperBlock to discrete 
time was accomplished using the Transform SuperBlock utility in SystemBuild. This 
enables the user to automatically transform SuperBlocks from continuous to discrete time 
or from one discrete rate to another. Invoked from the Build menu in SystemBuild, the 
Transform SuperBlock dialog allows multiple SuperBlocks to be transformed together 
and provides detailed control over how the block parameters are affected during 
transformation. During this transformation all interconnections and labeling information 


is preserved. A continuous to discrete transformation is shown in Figure 5.5. 


Contkmous SuperBlock Extinputs Ext Outputs 
continuous 1 1 


Integ 
eo 
Use Transform, 
and this 


continnous 0.2000 

changes 

4 Into this 
ES 





Figure 5.5: Continuous to Discrete Transformation 


The implications of transforming from continuous to discrete vary depending on 


the type of blocks in the model: [Ref. 9] 


e Algebraic, Logical and other blocks without dynamics or memory are 


unaffected 


EZ 


e Most dynamic blocks (time delay and integrators) maintain their coefficients, 
except for the compensation for the new sampling interval (T). 

e State Space, NUM/DEN and Gain/Zero/Poles blocks require new coefficients 
and are transformed from continuous to discrete using Tustin’s (trapesoidal) 
me. 

Transformation from continuous to discrete using Transform SuperBlock 
launches a dialog showing a SuperBlock Catalog listing all loaded SuperBlocks and their 
sample rates. From this list the user may select a hierarchy, all or individual SuperBlocks 
to transform. The dialog prompts for four pieces of information that control the 
transformation: 

e New sample interval (0 = cont) 

e New first sample (skew) 

e Discrete to Discrete transform (rate only or rate and block coefficients) 

e Transform initial conditions (of state space blocks) 

Clicking the Transform button completes the process, updating the new rates and 
overwriting the old SuperBlocks. 

74 Discrete Simulation 

Using the method described above, the pos_updt_mdl SuperBlock was 
transformed from continuous to discrete with a sampling interval of .04 seconds (25 Hz). 
The initial discrete simulation was run with all SuperBlocks sampled at the same rate of 
25 Hz to establish a baseline for comparison of the multi-rate characteristics of the filter. 
On successive simulations the gps_updt SuperBlock was transformed to slower sample 


rates to simulate DGPS update performance. 
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Transforming the gps_updt Superblock to a slower sampling rate than the rest of 
the system results in the multi-rate system. This was done to simulate the DGPS position 
usually being available once a second with infrequent delays of 2-3 seconds. It is this 
characteristic that requires the filter feedback gains to be turned off when the DGPS 
position information is not available. Consequently, the DGPS update logic blocks (6, 93 
and 98) and the data path switches (blocks 16 and 97), used to connect and disconnect the 
gps_filt feedback gains were incorporated to the system. The final discretized filter is 


shown in Figure 5.6. 





Figure 5.6: Discrete gps_filt SuperBlock 
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Initial conditions for these discrete simulations were {u=80,r=.1,phi=.2,P9=880}. 
Those parameters not listed were zero. Position error (Ps) and wind estimates outputs in 
Figure 5.7 shows the results of the discrete simulation of the system with DGPS update 


rate of 1 Hz. 
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Figure 5.7: Position Error and Wind Estimate (gps_updt=1 sec) 
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3. Effects of Angle-of-Attack and Sideslip 


Having established the implementation of the discrete time filter in simulation it 
was now necessary to examine the errors introduced by the assumption that the body and 
wind frames are essentially the same for the flight envelope of the FROG. This was 
examined using the values for angle of attack and sideslip developed in the FROG model 


used in the discrete simulations. These @ and £ quantities were used as inputs to the 


rotation matrix ?C defined in Chapter II to transform the measured indicated velocity 
from wind to body frame. This velocity was then used as input to the position filter. The 
filter position estimates were compared to the results from the previous simulations 
where alpha and beta were assumed to be zero. Simulations were run using wind speed 
inputs to the FROG model of 0 to 50 feet-per-second made up of north and east 
components. 

Angle-of-attack measurements from the FROG model fell in a range of -.02 to 
+.042 radians and the sideslip values ranged from +/- .1 radians. As expected the 
difference between position estimates using the actual {w} to {b} rotation matrix and 
those generated using the assumption of that matrix being identity were less than one 


percent. 
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VI. FLIGHT TEST 


A. FLIGHT TEST SETUP 

Proper functioning of the position filter relies on the availability of accurate LTP 
position data from the DGPS system. The configuration of two software items must be 
checked prior to take-off to ensure proper DGPS function. For the software, the 
coordinates of the LTP origin must be set and confirmed in both RealSim and the DGPS 
receiver coding. Coordinates within the RealSim software were verified using the 
following procedure. From the GUI Master page shown in Figure 6.1, select the LTP 
Navigation page. From this page, shown in Figure 6.2, view the coordinates displayed 


for latitude, longitude and geoide height of the LTP origin. 


{or interactive_Agimatien 


MASTER 








Figure 6.1: IA Client Master Page 
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Figure 6.2: IA Client LTP Navigation Page 


The coordinates for the surveyed spot at Chular (RC) airfield, where the 
differential GPS antenna is located during flight test, are set as default values in the 
Orig_lat_0, Orig long _0 and Orig _hgt 0 icons on the LTP Navigation page. 
Modifying the coordinates is accomplished by double-clicking the upper right hand 
corner of the respective display box to open the data input menu. From this menu the 
initial values, range of accepted values and other variable parameters may be changed. 
The sequence is completed by selecting the “Done” button. Initial coordinates within the 


DGPS receiver are checked and modified using the luggable PC or auxiliary laptop 
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notebook computer with the “GPS40” program. Specifics on this procedure are outlined 


Innere] 


B. FLIGHT TEST PROCEDURE 


- Data Acquisition 

Data acquisition during flight test was accomplished using the Data Acquisition 
utility described in Chapter HII. This utility enables the user to record essential 
SystemBuild input and output signals for use in system analysis. Figure 6.3 lists data 


recorded during flight test with the Data Acquisition Utility: 
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Figure 6.3: Signals Recorded Using Data Acquisition Utility 


Jp Preflight Checks 

Following the calibration of the D_to_A converter the LTP Navigation page was 
selected from the GUI master page. Start Controller was selected and the Pos GPS 
readings and GPS Update icon were checked to ensure DGPS updates were being 


received. Pos Est and Pos err readings were then checked against the Pos GPS values to 
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ensure proper function. The Psi display was checked by rotating the UAV 360 degrees 
and noting the associated heading angle in degrees. Wind values were checked to be at or 
near zero with the UAV stationary. Both graphical displays were checked to ensure a 
reflection of the position error and wind readings, respectively. All LTP position, wind 
and angle estimate readings were monitored as the UAV was taxied from the preflight 
area to the runway in preparation for takeoff. 

3. Flight Test Conduct 

Four test runs were planned and executed at the Chular (RC) Airfield. On each 
two to three minute run the filter gains were increased so that a range of filter 
performance data would be accumulated with gains values of two, five, eight and ten 
respectively. Flight paths test runs consisted of steady turning circles approximately 4000 
feet in diameter and constant throttle settings. Each of the last two runs were successive 
level runs north and south along runway heading with wings level lengths of 
approximately 2000 feet and associated reversals at constant throttle settings. 

The Data Acquisition utility was started approximately 3 seconds prior to the 
beginning of each run and stopped immediately upon run completion to record the signals 
discussed in part One of this section. The UAV pilot maintained control throughout the 


flight test. 


c. DATA ANALYSIS 

The data recorded using the Data Acquisition utility was converted from the .raw 
to .dat form as discussed in Chapter IV. These multiple .dat files made up of 
approximately 180 seconds of flight test data signals were concatenated and saved to a 


.xmd file for use in Xmath/SystemBuild. It was now possible to analyze the flight test 
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data by driving the filters and models with the necessary real-time signals acquired 
during flight. This analysis was conducted using the Xmath and SystemBuild tools. 
Procedures were similar to those used in the simulation of the discrete time model. 

1. Heading Data Analysis 

Prior to analyzing the performance of the position filter it was first necessary to 
determine which heading signals would be most suitable for use in the navigation and 
position filters. Heading information was available from both the IMU and GPS as the 
signals psi_imu and hea respectively. Psi_imu and hea were inputs nine and 14 to the 
Sensor Filters SuperBlock where either could be used in_ both the 
simple_complementary_filter_psi SuperBlock to generate an estimate of psi and as an 
input to the gps_filt SuperBlock for use in the rotation matrix from {b} to {u}. Samples 


of these two signals are shown in Figure 6.4. 


Heading (deg) 





1oo 150 


Tithe (sec) 


Figure 6.4: Headings hea and psi_imu 
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It is immediately evident that the IMU heading information, psi_imu, lags 
significantly. Analysis of the IMU heading information prior to flight test had not 
revealed this lag. But as shown and with all observed flight test data the IMU heading 
consistently lags that from the DGPS. It is clear from this comparison that despite the 
slow update and data latency, DGPS heading should be used as the input to both the 
simple _complimentary_filter_psi and gps _filt SuperBlocks for the generation of 
psi_hat and {b} to {u} rotation matrix, respectively. 

ae Heading Validation 

Using GPS heading, generation of heading estimate psi_hat was now validated 
using the autopilot and FROG models used in simulation. To complete this process the 
frog_a_p SuperBlock was constructed. This SuperBlock shown in Figure 6.5 was made 
up of the autopilot, frog and combined with the Sensor Filters SuperBlock to make up 
the frog _val_mdl SuperBlock. The goal of this procedure was to compare the heading 


estimates generated by the complementary filter with those generated by the FROG 


model. 





8 57.295 





Figure 6.5: Frog Model Validation SuperBlock frog_a_p_mdl 
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The autopilot/FROG model combination was driven with yaw and climb rate 
command signals (r and zdot) available from the data.xmd file. The actual flight test 
PWM command and transmit signals used were ail cmd_us, elev_cmd_us, ail_ pwm, 
and elev_pwm. The distinction between the two pairs of signals is that ail_pwm and 
elev_pwm are the PWM commands sent from the computer to the Futaba transmitter and 
ail cmd_us and elev_cmd_us are the actual PWM transmitted to the UAV autopilot. Use 
of the commanded signals involved incorporating a 200 ms delay in both the aileron and 
elevator channel prior to the autopilot input to simulate command-transmit-receive lag. 

These r and zdot commands in PWM form were first converted to units of 
degrees-per-second and feet-per-minute respectively using the slope and x-intercept 
calibration information established in [Ref. 8] and finally to radians-per-second and feet- 
per-second for input to the autopilot model. 

The heading output psi_mdl was compared to the filter estimated heading psi_hat 
generated using DGPS headings from several different flight test data sets. A sample of 
these results in Figure 6.6 show the model headings correlate well with the filter 
estimated headings. This further justifies the use of model generated heading in the 
continuous and discrete filter simulations. 

3. Filter Position 

Evaluation of the position filter was accomplished using the 15 inputs required by 
the Sensor Filter SuperBlock, previously discussed and listed in Figure 6.3. These 
signals were available in the data.xmd files constructed from several flight tests. Psi hat 
generated from DGPS heading input to the complementary filter was used as the psi input 
to the position filter. Neither phi nor theta estimates from the complementary filters were 


validated at this time and were assumed to be zero for the purposes of filter evaluation. 


43 


ee A ee a) eT 






weer ecenwe dwn ewe 2 - He ewe ewe = 


“eee ee eee gp He emma w wee ecw 


Ramp Heed'rg (deg) 


eeee 
_= =—_ 





eee ec ew —- = = = = =H 


oe vrewese 
—— oe eo oo 


Time (sec) 


Figure 6.6: Psi _mdl and Psi_hat 


In this process DGPS heading and position information were input to the filter 
and the resulting position and wind estimates evaluated. As with the heading validation 
multiple data sets from different flight tests were used providing a wide range of wind 
conditions with which to evaluate the system position estimate. 

Filter estimated LTP position was compared to DGPS data in the north, south and 
down channels. Figure 6.7 shows a sample of the north channel comparison for a 


particular data set. 
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Figure 6.7: North DGPS and Estimated Position 


The filter estimated position tracks the actual DGPS position well with some 
notable exceptions. As expected, the filter position appears as a ramp between the 
discrete DGPS data tracking the corer of each successive update. The estimated position 
spikes are caused by the absence of DGPS update information to the filter. This latency 
will be addressed in Chapter VII. Without the necessary position updates the filter 
continues to integrate the inertial velocity with no updated error signal. Lack of heading 
information further aggravates the estimate. As time goes on the affects of DGPS 


position latency are diminished due to the filter having refined its wind estimate. 
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Comparing these flight test results with north channel simulation shown in Figure 
6.8 illustrates the effects of poor DGPS position and heading update rate on filter 


performance. 
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Figure 6.8: North True and Estimated Position from Simulation 


Simulation results using DGPS update rate of 1 Hz without interruption clearly 


show the filter providing accurate position estimates within 30 seconds. 
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The east channel sample results shown in Figure 6.9 are much the same as those 


observed in the north. 
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Figure 6.9: East DGPS and Estimated Position 


In an attempt to demonstrate the effect of poor heading information on estimated 


position the heading information available from the FROG model driven by flight test 


4°] 


yaw and climb rate PWM commands was used as the psi input to the position filter. The 


north channel estimated and DGPS positions are shown in Figure 6.10. 
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Figure 6.10: North DGPS and Filter Estimated Position Using Psi Model 


The magnitude of the estimated position error in the absence of DGPS update is 


reduced by approximately 70 percent. This is accounted for in the availability of accurate 
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25 Hz heading information from the model. 

heading information would greatly increase the accuracy of the filter position estimate. 
Down channel LTP position estimate in Figure 6.11 1s, as expected, the most 

oscillatory due to the lack of theta and phi estimates. Since there is very little if any wind 


component in the down channel, the filter relies on the DGPS updates as the sole means 


of determining position error. 
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Figure 6.11: Down DGPS and Filter Estimated Position 
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From this it is clear that quality IMU 


4, Wind Estimate 


Accurate position estimation is a function of the wind estimate made by the filter. 
As discussed in Chapter III the filter should accurately estimate the existing steady state 


wind while rejecting the gusts. Figure 6.12 shows the unfiltered wind estimate output in 


all three channels. 
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Figure 6.12: North, East and Down Filter Wind Estimate 
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It is clear from Figure 6.12 that this wind information contains high frequency 
components. By inspection the down channel wind is estimated to be negligible even 
without filtering. Such is not the case with the north and east components. In order to 
extract the desired information, the prevailing wind condition, it 1s necessary to filter the 
north and east signals. To this end a Butterworth filter with a cutoff frequency of .005 Hz 
was employed after the wind estimate integrator and the resulting low-pass filtered wind 
signals displayed on the IA LTP Navigation page. A sample of the filtered wind results 


from flight test are shown in Figure 6.13. 
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Figure 6.13: Raw and Filtered Wind 
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Noticing scaling, these results show the major wind component in the N channel 
with a magnitude approaching 15 to 20 fps. This approximates the actual north wind of 
15 to 25 fps in which that flight test data was taken. The long delay in the filtered wind is 
caused by the Butterworth filtering. Longer data set would refine the estimate. 

5. Bank Angle Estimate 

Although the bank angle information provided by the IMU in the form of Euler 
angle phi was unusable, it was possible to generate and estimate of phi using the 


relationship: 
p= Veta. Big 13 
§ 


Heading rate needa for this calculation was available as an output from the 
simple_complementary_filter_psi SuperBlock. This signal was filtered using a 
Butterworth filter with a cutoff frequency of 05 Hz. Airmass velocity resolved in inertial 
frame was input from the position filter. This calculation was carried out in the phi_filt 
SuperBlock located within the Sensor Filters SuperBlock. The implementation is shown 


in Figure 6.14. 
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Figure 6.14: Phi Filter SuperBlock 
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A sample of the bank angle estimate generated using the phi_filt implementation 


with the FROG in a constant turn is shown in Figure 6.15, 


Bank Angle Phi (deg) 





Time (sec) 


Figure 6.15: Phi Estimate Using Heading Rate 


A comparison of this phi estimate with the actual flight profile for this data set 
shows the estimated results to be close to the angle of bank used in the steady turn for 
flight test. As with the wind filter, the large delay is caused by the use of the Butterworth 
filter. Although this signal would not be suitable for control purposes due to the lag, an 


improved yaw rate source would alleviate the need for the Butterworth filter for y. 


ro He. 


These results are very close to those obtained through simulation under similar 


flight conditions. A sample of the simulated phi estimate is shown in Figure 6.16. 
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Figure 6.16: Phi Estimate from Simulation 
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VII. CONCLUSIONS AND RECOMMENDATIONS 


A. CONCLUSIONS 

The primary goal of this thesis was to design a multi-rate position filter to provide 
accurate position estimates between the 1 Hz DGPS updates. This was accomplished 
using complementary filtering of the DGPS position and of indicated airspeed both 
resolved in the LTP inertial frame. In the implementation of this filter the heading 
information necessary in the transformation from {u} to {b} was provided by the DGPS. 
Filter performance in simulation and flight test revealed the ability of the filter to estimate 
the wind and provide accurate position information was mainly a function of availability 
of DGPS position information. 

Analysis of the flight test performance of the filter displayed its ability to 
accurately estimate vehicle position despite poor DGPS update rates. Further filtering of 
filter generated wind provided the user with an accurate low frequency estimate of the 
existing wind conditions. 

Despite successful demonstration of this filter the two problems i poor DGPS 


update rates and slow IMU heading information yet to be solved. 


B. RECOMMENDATIONS 

Ie DGPS Update Rate 

As evidenced in the analysis of the flight test data filter performance is a function 
of the DGPS update rate. Latency in the receipt of DGPS position information disables 
the evaluation of the existing wind by the filter resulting in poor position estimates. An 


examination of the data sets from the past eight flight tests shows DGPS update rates 


ops. 


averaging between .73 and .78 Hz well below the advertised 1 Hz nominal. The cause of 
this update problem has been isolated to the Freewave RF modems used to provide the 
communication link between the ground station and the UAV. An adjustment of the 
communication protocols must be made in the software that would allow the proper 
establishment of two-way communication between the ground and UAV units. 

Z Heading Information 

Flight test results revealed the poor quality of nearly all IMU data. Consequently 
only the roll, pitch and yaw rates from the IMU were ultimately used in the current 
version of the filter. IMU heading information was noticeably slow, appearing to have 
been filtered. IMU settings must be analyzed to determine if the current data is being 
sent in filtered or raw form. If it 1s found to be raw data then the IMU must be removed 
and replaced with a unit that as a minimum will provide adequate heading information for 
standard rate turns of 12 deg/sec. Should the examination of the IMU settings reveal the 
present data is being sent in a filtered form, the settings should be changed to send raw 


heading information. 
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APPENDIX A. INDICATED AIRSPEED CALIBRATION 


Indicated airspeed was sensed by the pitot-static system on the FROG UAV. This 
measured voltage was discretized using the IMU Analog to Digital Converter (ADC) and 
then transmitted to the ground station via the Freewave RF modem. The discretized 
voltage sensed by the ground station was quite noisy and consequently put through a 
simple smoothing filter. Using data from numerous flight tests, the mapping from sensed 


voltage to indicated airspeed in units of feet-per-second was established [Ref. 7]. 


Y=-01-U° + 1618-U’ —10.422-U* + 3498-U’ — 67.96-U* + 99.46-U + 10 


This conversion which takes voltage as the input was again modified following 
comparison to DGPS velocity under no wind conditions. Below is the airspeed 
conversion SuperBlock found in the Calibrate Sensors SuperBlock of the flight_test_rf.rtf 


file. 





Airspeed Conversion SuperBlock 


59 





APPENDIX B. DGPS UPDATE LOGIC BLOCKSCRIPT 


This C-code is found in the Plogic SuperBlock within the position filter. This 
simple logic compares the norm of the current DGPS position signal with that of the 
previous. If the difference of that operation is zero, there has been no update and the 
output of the logic is low (zero). If the difference is non-zero, there has been and update 
and the logic output is high (one). This output triggers the data path switches which turn 


the feedback loop gains on and off. 


Inputs: u; 
Outputs: y; 

States: x; 

next_ States: xnext; 
float u(:), y, x; 


x=(u(1)2 + u(22)2 + u(3)2)0.5; 


ifx == 0 then 
y =0; 
else 
=|; 
endif; 


oval 
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